home *** CD-ROM | disk | FTP | other *** search
/ MacHack 1999 / MacHack 1999.toast / The Hacks / Rotato / Source / ADBServiceProc.c next >
Encoding:
C/C++ Source or Header  |  1999-06-25  |  5.4 KB  |  225 lines  |  [TEXT/CWIE]
  1.  
  2. #include <math.h>
  3. #include <DeskBus.h>
  4.  
  5. #include "PrefResource.h"
  6.  
  7. #include "ADBServiceProc.h"
  8.  
  9. #define kMouseADBAddress            3
  10. #define TwosComplement(n)              ((~(n)) + 1)
  11.  
  12. #define kButtonStateMask                0x80
  13. #define kValueMask                    0x7F
  14.  
  15.  
  16. // global data polity
  17. //
  18. // The install routines create a ptr in the sys heap, and install a Gestalt value with
  19. // its address. They also set up a global for the service routines.
  20. //
  21.  
  22. TPrefsDataPtr        gADBGlobals;        // ptr in sys heap
  23.  
  24. void main(void);
  25.  
  26.  
  27. #define ROTATE_AXES
  28.  
  29. #if TARGET_CPU_68K
  30.  
  31. asm void MyCallADBServiceProc(Ptr buffer, TempADBServiceRoutineUPP completionProc, Ptr refCon, long command, ADBServiceRoutineUPP foo)
  32. {
  33.     _Debugger
  34.     link        a6,#0
  35.     move.l    a4, -(a7)
  36.     move.l    0x18(a6), a4
  37.     move.l       0x14(a6),d0
  38.     movea.l    0x10(a6),a2
  39.     movea.l    0x0C(a6),a1
  40.     movea.l    0x8(a6),a0
  41.     jsr           0(a4)
  42.     move.l    (a7)+,a4
  43.     unlk          a6
  44.     rts
  45. }
  46.  
  47. #endif
  48.  
  49.  
  50. /*----------------------------------------------------------------------------
  51.     ADBMouseServiceRoutine 
  52.     
  53.     Handler for Mouse service routine
  54. ----------------------------------------------------------------------------*/
  55. pascal void ADBMouseServiceRoutine(Ptr buffer, TempADBServiceRoutineUPP completionProc, long refCon, long command)
  56. {
  57.     unsigned char    num, buttonstate, count;
  58.         
  59.     for (count = 0; count < buffer[0]; count++)
  60.     {
  61.         // high most bit is the button state
  62.         // get the x and y data and take the 2's complement to reverse direction
  63.  
  64.         buttonstate = buffer[count + 1] & kButtonStateMask;
  65.         num = buffer[count + 1] & kValueMask;
  66.  
  67. #if REVERSE_DIRECTION
  68.         // swap left right and up down
  69.         num = TwosComplement(num);
  70. #endif
  71.         buffer[count + 1] = (num & kValueMask) | (buttonstate & kButtonStateMask);
  72.     }
  73.  
  74. #if CHANGE_BUTTON_STATE
  75.     // swap button up and button down
  76.     buffer[1] = (buffer[1] & kValueMask) | (~(buffer[1]) & kButtonStateMask);
  77. #endif
  78.  
  79. #ifdef ROTATE_AXES
  80.     
  81.     for (count = 1; count < buffer[0]; count++)
  82.     {
  83.         UInt8    button1State = buffer[count] & kButtonStateMask;
  84.         UInt8    button2State = buffer[count + 1] & kButtonStateMask;
  85.         
  86.         SInt8    xAfter, xMoved = (buffer[count] & kValueMask);
  87.         SInt8    yAfter, yMoved = (buffer[count + 1] & kValueMask);
  88.         
  89.         double    xDiff, yDiff;
  90.         double    xNew, yNew;
  91.         double    xSign, ySign;
  92.         double    hypot, theta;
  93.         
  94.         // promote the sign bit if -ve
  95.         xMoved |= (xMoved & 0x40) << 1;
  96.         yMoved |= (yMoved & 0x40) << 1;
  97.         
  98.         // my brain is too tired to figure out better logic here.
  99.         if (xMoved < 0 == yMoved < 0)
  100.         {
  101.             // NE or SW quadrant (assuming +ve is up)
  102.             xSign = (xMoved < 0) ? -1.0 : 1.0;
  103.             ySign = (yMoved < 0) ? -1.0 : 1.0;
  104.         }
  105.         else if (xMoved < 0)
  106.         {
  107.             // NW quadrant
  108.             xSign = -1.0;
  109.             ySign = -1.0;
  110.         }
  111.         else
  112.         {
  113.             // SE quadrant
  114.             xSign = 1.0;
  115.             ySign = 1.0;
  116.         }
  117.         
  118.         xDiff = (double)xMoved;
  119.         yDiff = (double)yMoved;
  120.         
  121.         hypot = sqrt(xDiff * xDiff + yDiff * yDiff);
  122.         theta = atan(yDiff / xDiff);
  123.         
  124.         theta += gADBGlobals->thetaDelta;
  125.         
  126.         xNew = hypot * cos(theta) * xSign;
  127.         yNew = hypot * sin(theta) * ySign;
  128.         
  129.         xAfter = (SInt8)xNew;
  130.         yAfter = (SInt8)yNew;
  131.         
  132.         buffer[count] = (button1State | (xAfter & kValueMask));
  133.         buffer[count + 1] = (button2State | (yAfter & kValueMask));
  134.     }
  135.  
  136. #endif
  137.  
  138. #if TARGET_CPU_68K
  139.     MyCallADBServiceProc(buffer, completionProc, (Ptr)gMouseADBinfo.dbDataAreaAddr, command, gOldMouseServiceRoutine);
  140. #else
  141.     CallADBServiceRoutineProc(gADBGlobals->oldMouseServiceRoutine, buffer, completionProc, (long)gADBGlobals->mouseADBinfo.dbDataAreaAddr, command);
  142. #endif
  143. }
  144.  
  145. /*----------------------------------------------------------------------------
  146.     MyInstallServiceRoutines 
  147.     
  148.     Setup our service routines
  149. ----------------------------------------------------------------------------*/
  150. Boolean MyInstallServiceRoutines(void)
  151. {
  152.     short            adbcount, adbindex;
  153.     OSErr            err = paramErr;
  154.  
  155.     adbcount = CountADBs();
  156.  
  157.     for (adbindex = 1; adbindex <= adbcount; adbindex++)
  158.     {
  159.         ADBDataBlock    adb_data;
  160.         long            adbaddr = GetIndADB(&adb_data, adbindex);
  161.     
  162.         if ((adb_data.origADBAddr == kMouseADBAddress))
  163.         {
  164.             ADBSetInfoBlock    setADBInfo;
  165.  
  166.             BlockMoveData(&adb_data, &gADBGlobals->mouseADBinfo, sizeof(ADBDataBlock));
  167.             // Remember we will be called once to install and twice during each ADBReInit
  168.             if (!gADBGlobals->myMouseServiceRoutine)
  169.             {
  170.                 THz    curZone = GetZone();
  171.                 SetZone(SystemZone());
  172.                 gADBGlobals->myMouseServiceRoutine = NewADBServiceRoutineProc(ADBMouseServiceRoutine);
  173.                 SetZone(curZone);
  174.             }
  175.             if (!gADBGlobals->myMouseServiceRoutine)
  176.                 return false;
  177.  
  178.             gADBGlobals->oldMouseServiceRoutine = adb_data.dbServiceRtPtr;
  179.             setADBInfo.siService = gADBGlobals->myMouseServiceRoutine;
  180.             setADBInfo.siDataAreaAddr = adb_data.dbDataAreaAddr;
  181.  
  182.             err = SetADBInfo(&setADBInfo, adbaddr);
  183.             return (err == noErr);
  184.         }
  185.     }
  186.     
  187.     return false;
  188. }
  189.  
  190.  
  191. /*----------------------------------------------------------------------------
  192.     MyADBInitProc 
  193.     
  194.     needed to re-install our service routine
  195. ----------------------------------------------------------------------------*/
  196. void MyADBInitProc(SInt8 callOrder)
  197. {
  198.     Boolean        InstallOK;
  199.  
  200.     CallADBInitProc(gADBGlobals->oldADBInitProc, callOrder);
  201.     if (callOrder)
  202.         InstallOK = MyInstallServiceRoutines();
  203. }
  204.  
  205.  
  206. /*----------------------------------------------------------------------------
  207.     SetupData 
  208.     
  209.     needed to re-install our service routine
  210. ----------------------------------------------------------------------------*/
  211. OSErr SetupData(void)
  212. {
  213.     // Set up our global data
  214.     return Gestalt(kDataGestaltSelector, (long *)&gADBGlobals);
  215. }
  216.  
  217.  
  218. ProcInfoType __procinfo = kThinkCStackBased;
  219.  
  220. void main(void)
  221. {
  222.     //nothing to do
  223. }
  224.  
  225.